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Abstract 

Probabilistic Cell Decomposition (PCD) is a probabilistic path planning method combining the concepts of approximate cell 
decomposition with probabilistic sampling. It has been shown that the use of lazy evaluation techniques and supervised sampling 
in important areas result in a high performance path planning method. Even if it was postulated before that PCD is probabilistically 
complete, we present a detailed proof of probabilistic completeness here for the first time. 

I. Introduction 

The problem of path planning appears in many different forms that seem only loosely connected at first. An instance of 
the problem could, for example, be a point like agent that has to traverse a maze, an articulated robot that has to move from 
one configuration to another or path planning for a free-flying rigid body. Additional examples include analysis of folds of 
large molecules, assembly / disassembly planning or path planning for animated characters. They all have in common that 
some kind of agent has to move from a start to a goal position avoiding collisions with static obstacles and self-collisions 
along the way. The problem can be transferred to the so called configuration space C where the problem reduces to finding 
a continuous path for a point connecting the start with the goal configuration. This comes at the cost that the dimension of 
C can be much higher than the dimension of the workspace W. In general, the dimension of C corresponds to the number of 
degrees of freedom of the agent. Another drawback of planning in C is that for all but trivial problems the computation of an 
explicit representation of obstacles in C is computationally too expensive to be feasible. Information on C-space obstacles is 
available through a boolean collision-check function only. An algorithm can probe a specific configuration and gets an answer 
whether it is collision-free or not. Eor a given configuration q, the collision-check function checks whether the image of q in 
W collides with an obstacle in W. 

In HI we introduced a new method for solving path planning queries: Probabilistic Cell Decomposition (PCD). We indicated 
that PCD is probabilistically complete. However, in this paper, we provide a detailed proof of probabilistic completeness of 
PCD for the first time. An algorithm is said to be probabilistically complete if for the case that a collision-free path exists, the 
probability of the algorithm successfully solving the path planning query approaches one when more and more computation 
time is spent on the problem. 

This technical report requires a basic understanding of path planning concepts. A good introduction and a broad overview 
over the held of path planning are offered by a, a, a. 

In the following section we briefly introduce the algorithm and its basics components. We will then discuss some challenges 
in proving probabilistic completeness for PCD compared to other probabilistically complete path planning methods like 
Probabilistic Roadmaps (PRM) 0, a, a Rapidly-exploring Random Trees (RRT) 0,0. Einally, we prove probabilistic 
completeness for PCD. Eor further reading on PCD we refer to m, im, in. 

II. Probabilistic Cell Decomposition 

PCD resembles an approximate cell decomposition method where cells have a simple predefined shape. As in most 
approximate cell decomposition methods, PCD divides the configuration space C into almost disjoint closed rectangloid cells. 
Almost in the sense that neighboring cells share a common boundary and configurations on this boundary belong to both cells. 

PCD does not require an explicit representation of the configuration space obstacles but only a binary collision checker that 
can probe a specific configuration for collision. Thus, it is never known whether a cell is entirely free or entirely occupied by 
(J-obstacles. Instead, a cell is assumed to be free until disproval. A cell is called possibly free, as long as only collision-free 
samples have been found in the cell. Accordingly, it is called possibly occupied if all samples that have been checked are 
colliding. If both collision-free and colliding samples have been found in the same cell, it is mixed and has to be split up into 
possibly free and possibly occupied cells. 

The possibly free cells form the nodes of the connectivity graph Q. Two nodes are connected by an edge if the corresponding 
cells are adjacent. In contrast to classical approximate cell decomposition methods the concept of possibly free cells implies 
unfortunately that from a cell path in Q we cannot automatically deduce an existing feasible continuous path. The states along 
a continuous path through this cell path have to be checked for collision. Accordingly, from the fact that no cell path exists 
in Q we cannot conclude that no continuous path exists. 
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A. Notation 

Let us introduce the basic notation. 

PCD works in the conhguration space C. The open subset of collision-free conhgurations is denoted by Cuee L C and the 
set of colliding conhgurations is given by Cobst = C\ Cfree- PCD will decompose C into rectangloid cells k. Such a cell k can 
be 

• possibly free, i.e. P{k C Cfree) > 0, 

• possibly occupied, i.e. P{k C Cobst) > 0, 

• mixed, i.e. k <f_ CfreeAK Cobst or 

P(k C Cfree) = c Cobst) = 0. 

Let Kstart and Kgoai denote the possibly free cells containing the initial and the goal conhguration, gstan and qgoai, respectively. 
Note that throughout the decomposition process these labels will be passed to different cells when the respective cells get split. 

The possibly free cells form the nodes of the connectivity graph Q. Two nodes are connected by an edge if and only if the 
corTesponding cells are adjacent. The set of cells corresponding to the connected component of Q containing Kstart is called 
the start region T^-stan, accordingly for the goal region A path in Q connecting Kstart with /Cgoai is called a channel or cell 

path interchangeably. 

B. The Basic Algorithm 

Algorithm [T] shows the basic algorithm of PCD. It is initialized with one possibly free cell Kstart = Kgoai = C. Thus, initially Q 
has only one single node. The outer while-loop simply loops forever until a solution has been found. Like other probabilistic 
path planning methods, PCD is not able to determine that no feasible path exists. One iteration of the outer while-loop is 
considered one iteration of PCD. The inner while-loop (lines 2-9) continuously searches for a cell path connecting Kstan with 
Kgoai- It breaks if no such cell path could be found (findCellPath (G) = null). If a cell path is found, a continuous 
local path through this channel is checked for collision (checkPath (cellPath)). If the continuous path is found to be 
collision-free, the path planning query is solved. Otherwise, a collision has been found in a possibly free cell. Thus, this cell 
is mixed and, in splltMlxedCells, all mixed cells are split into possibly free and possibly occupied cells. 

When the inner while-loop breaks, Kstan and Kgoai are in different connected components of Q. Therefore, the possibly 
occupied cells get sampled (randomState (posslblyOccupledCells)) in order to rehne them and try to reconnect 
^stan with T^goai in G- If one of the samples happens to be collision-free, the corresponding cell is mixed as it contains both 
colliding and collision-free samples. Thus, this cell has to be split into possibly free and possibly occupied cells. 

By alternately sampling and local path checking, the cell decomposition is iteratively rehned until a collision-free path is 
found through a channel of possibly free cells. 

The basic algorithm shown in Algorithm [T] is equivalent to the one presented in ITJ. 


Algorithm 1 The Basic algorithm of PCD 
1 : while not success do 

2: while null cellPath ^ hndCellPath(G) do 

3: if checkPath(cellPath) then 

4: success ■(— true 

5: break while 

6 : else 

7: splitMixedCells 

8 : end if 

9: end while 

10 : if not success then 

11: samples ^ randomState(possiblyOccupiedCells) 

12: if not collisionCheck(samples) then 

13: splitMixedCells 

14: end if 

15: end if 

16 : end while 


f indCellPath (G) . f indCellPath searches the connectivity graph Q given by G for a cell path connecting the start cell 
Kstart with the goal cell rcgoai- In H] A*-search is used for graph search. For this proof, the actual graph search method is 
of no particular importance. It just has to be complete in the sense that it hnds a path in Q if one exists. If a cell path is 
found, it is stored in cellPath. Otherwise, cellPath is set to null and the inner while-loop breaks. 
checkPath (cellPath) . In checkPath (cellPath), a continuous path through the cell path given by cellPath is 
checked for collisions. First a continuous local path is derived from the cell path. In HI the strategy is to connect the 







2 


centers of shared boundaries between adjacent cells along the cell path. Again, the actual choice of local path planning 
method is not important as long as the local path stays inside the cell it shall traverse and the various local paths together 
form a continuous path connecting gstan with qgoai- The continuous path is then checked for collision. We assume here 
that we have a method that provides an answer in hnite time whether the continuous path is collision-free or not. In 
most implementations this will be done by checking conhgurations along the path at a given resolution. In contrast to 
the approach presented in m, conhgurations that have been verihed as collision-free in this step are not stored in the 
respective cell. This considerably simplihes the analysis of the algorithm. We will point out later in the proof where this 
fact is used. 

If the continuous path is found to be collision-free, true is returned and the path planning query is solved. Otherwise, 
a collision has been found in a possibly free cell. Thus, this cell is known to be mixed, false is returned and, in the 
next step, all mixed cells are split into possibly free and possibly occupied cells. 
splitMixedCells. If a cell contains both colliding and collision-free samples it is mixed and has to be split into possibly 
occupied and possibly free cells. For this proof we assume that in splitMixedCells all mixed cells are split according 
to the rules dehned in m, i.e. cells are split in the middle between two samples of opposing type perpendicular to the 
dimension of largest distance between these two samples. This guarantees that all cells maintain the rectangloid cell 
structure. 

randomState (pOccCells) . randomState (pOccCells) draws one random sample in each possibly occupied cell 
according to a uniform distribution over this cell. The samples are stored in the vector q. 
collisionCheck (q) . The samples q drawn on the previous line are then checked for collision in collisionCheck (q). 
If all samples are colliding, collisionCheck returns true. Otherwise, if one or more samples in q are collision-free, 
collisionCheck returns false and the algorithm continues to splitMixedCells. 

The different subroutines are described in more detail in |[T]. Unlike in that paper, we assume that collision-free samples 
found in checkPath are not stored in the corresponding cell. Thereby, we discard information but simplify the analysis of the 
algorithm considerably. Only those collision-free samples are stored that are found by randomState in possibly occupied 
cells. Consequently, a possibly free cell contains only one collision-free sample (apart from the initial cell containing both the 
start and goal conhguration). 

The algorithm maintains two major data structures: 

binary tree The binary tree structure keeps track of all cell splits. The root of the binary tree is the initial cell cotTesponding 
to the entire conhguration space. When a cell is found to be mixed and split into possibly free and possibly occupied cells, 
the tree grows deeper from the corresponding leaf. Accordingly, the leafs of the tree are the possibly free and possibly 
occupied cells. All non-leafs are mixed cells. 

connectivity graph Q The connectivity graph Q holds all possibly free cells as nodes and connects two nodes by an edge iff 
the two cells are adjacent. Two cells are adjacent iff they share a common boundary with nonzero {n — l)-measure. 

Let k count the number of iterations of the outer while-loop. One iteration of the outer while-loop is considered one 
iteration of PCD. Refer to the inner while-loop (lines 2-9) with <a> and count the number of iterations of this inner loop 
with ka- ka is reset to zero with every iteration of PCD. Refer to the second if -clause (lines 10-15) with <b>. 

III. Probabilistic Completeness 

In this section we prove that PCD is probabilistically complete. 

Definition 1: Probabilistic Completeness. A path planning algorithm is said to be probabilistically complete if, for the case 
that a feasible path exists, the probability that the algorithm solves the problem approaches one as computation time goes to 
inhnity. 

The biggest drawback of a method which is only probabilistically complete is the fact that it cannot decide whether a problem 
is not solvable. If a probabilistically complete method is used on an unsolvable problem, it will simply run forever. This is in 
contrast to the much stronger concept of completeness. 

One can argue that knowing that an algorithm is probabilistically complete is not particularly useful when deciding which 
algorithm to choose for a problem at hand. An algorithm that regularly solves complex problems in short time without being 
probabilistically complete might be a better choice than an algorithm that is proven to hnd a solution with probability one 
when time approaches inhnity. Unfortunately, when time goes to infinity is rarely an option in serious applications. In any case, 
hndings from proving probabilistic completeness help in better understanding the algorithm and its performance. For related 
methods, results from this kind of analysis have often found their way into improvements of the basic algorithm. 

PCD is probabilistically complete and we provide a detailed proof in the following. We will hrst discuss the challenges in 
proving probabilistic completeness compared to proving this property for related methods like PRM or RRT. After introducing 
some required notation we give an outline of the proof followed by an extensive proof in all details. 

A. Challenges 

Compared to other probabilistic path planning methods like PRM or RRT, there are some characteristics in PCD that turn 
out being problematic in proving probabilistic completeness. Proofs of probabilistic completeness of PRM and RRT can be 
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found in ini, m, ii and ina. All three methods sample the configuration space and build graph structures to represent the 
connectivity of Cfree- The following listing names the most important differences and how they affect the proof. 

Non-uniform sampling. In the basic PRM or RRT methods, the conhguration space is sampled uniformly. In PCD, only 
the possibly occupied cells get sampled. While this is often speeding up the solution process, one can no longer assume 
uniform distribution of samples over C which would be benehcial for proving probabilistic completeness. With the number 
of samples going to inhnity a uniform sampling would be dense with probability one, i.e. any open subset of C would 
contain a sample with probability one. 

Cell structure. The underlying cell structure is instrumental in guiding the sampling. However, it may - in unfortunate cases - 
hinder the path planning process. Even if the existing feasible path has been sampled densely (not in the strict mathematical 
sense), in PCD a thin possibly occupied cell might block the path. PRM or RRT would identify this path easily. 
Monotonous progress. In PRM and RRT a node corresponds to a configuration in C and is added to the connectivity graph 
(i.e. roadmap or tree) if it is collision-free. An edge between two neighboring nodes in the connectivity graph corresponds 
to a continuous path between the respective conhgurations. It is added to the connectivity graph if it is collision-free. The 
connectivity graph Q is built monotonously and when start and goal configuration fall into the same connected component 
of Q the path planning query is solved. 

A node in the connectivity graph of PCD is never proven to be free. It represents a cell marked as possibly free since 
only collision-free samples have been found in this cell so far. An edge in the connectivity graph of PCD does in general 
not correspond to a specihc straight line path in C. In PCD, the local path through a possibly free cell depends on both 
neighbouring cells along the cell path. If a collision is found while checking this local path, not only an edge is removed 
from Q but a node. A colliding sample has been found in a - so far - possibly free cell. When the node gets removed 
from Q of course all edges leading to this node have to be removed as well - even if corresponding local paths were 
already checked for collision and proven to be collision-free. Hence, there is - at first glance - no monotonous progress 
in building the connectivity graph. 

It can be shown, however, that even in PCD there is monotonous progress in solving the path planning query. 

Role of colliding samples. In PRM and RRT colliding samples are not treated further. If a sample is found to be colliding 
while checking a node or an edge for collision, the respective node or edge is simply not added to the connectivity graph. 
In PCD colliding samples give rise to possibly occupied cells that may block a channel of possibly free cells. Thus, 
instead of just looking at the good samples that guide us to a continuous path we also have to consider bad samples that 
may actively hinder the solution process. 

Determinism. In all probabilistic path planning methods there are some parts of the algorithm that are deterministic - like 
graph search and connecting neighboring samples with a straight line path - and some others - in most cases only the 
sampling of C - that are probabilistic. For the analysis of probabilistic completeness, those deterministic parts are of 
particular importance that create new samples. 

Taking a look at the basic PRM and RRT algorithms, this does not pose any problem for proving probabilistic completeness. 
In the basic version of both algorithms, colliding samples are not stored, but only the respective link between two samples 
is marked as colliding. Collision-free samples found in this step are neither problematic. The proof of probabilistic 
completeness is solely based on the location of probabilistic samples and the deterministic capability of connecting two 
adjacent conhgurations by a straight-line path. 

In PCD deterministically derived samples affect the cell decomposition and hence the whole solution process. One can 
not assume that all samples in a cell are obtained by probabilistic sampling which would be benehcial for proving 
probabilistic completeness. Instead, in the following we apply a worst-case-scenario each time deterministic samples are 
to be considered; where might the deterministic sample pop up in a worst case to hinder the solution process. 

B. Notation 

We will hrst introduce some more notation required for the proof. 

We will prove probabilistic completeness for the metric space C = [0,1]” C M" with the Euclidian metric d. With di{q, q') = 
\qi — q'j\ we refer to the pseudometric that gives the distance between two conhgurations in a single dimension i. We use the 
short notation d or di if the two conhgurations whose distance is to be measured are unambiguous from the given context. 
With Di we denote specihc distances in dimension i such as D^, Df'^ or Uf for the width of a cell k, of an e-ball or of 
a further dehned intersection I. 

We will use the Lebesgue measure p” or /r to measure a volume in the n-dimensional conhguration space. Accordingly, 
measures a volume of an (n — 1)-dimensional subset of C. We will then use fractions of such measures to dehne probabilities 
for samples drawn from a uniform distribution. 

Let Cobst denote the closed semi-algebraic set of conhgurations from C where the binary collision checker returns collision. 
Accordingly, Cfree = C/Cobst is the open collision-free subset of C and is also semi-algebraic. 

Definition 2 (Semi-algebraic sets, m): A semi-algebraic subset of R" is the subset of {xi,... ,Xn) in R" satisfying a 
boolean combination of polynomial equations and inequalities with real coefficients. In other words, the semi-algebraic subsets 
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of K" form the smallest class SAn of subsets of K" such that; 

1) If P S R[Xi,..., Xn], then {a; G M"; P{x) = 0} G SAn and 
{x G K"; P{x) > 0} G SAn- 

2) If ^ G SAn and B G 5 ^, 1 , then AVJ B, ACi B and R" \ A are in SAn- 

Please observe, that the assumption of Cobst being a semi-algebraic set is a sufficient but not a necessary condition for the 
proof of probabilistic completeness to hold. It is simply a concrete specification of Cobst has to be sufficiently nice- On the other 
hand, it does not limit the application of this proof with respect to path planning for mobile manipulation. Robots and obstacles 
in W are usually defined using semi-algebraic models. These include polygonal and polyhedral models. Non-semi-algebraic 
models can be approximated arbitrary closely by semi-algebraic models. The mappings from W to C used in the common path 
planning applications, like translations and rotations, preserve this property. A robot defined by a semi-algebraic set moving 
around W-obstacles defined by semi-algebraic sets yields a C-obstacle region Cobst that can be described by a semi-algebraic 
set. 

Let 1C be the set of all possibly non-mixed cells, i.e. 1C = /Cpbee U /Cpocc where /Cpfree and /Cpocc are the sets of all possibly 
free and possibly occupied cells, respectively. 

Let now 

T ■ [b; P\ ' ^ Cfree; T(b) ~ Qstart; T(-^) “ t/goal 

denote a continuous path of length L connecting qstart with ggoai- By 7 we also denote the set of configurations corresponding 
to this path. 

Let furthermore Psucc(^) be the a priori probability of successfully finding a path using PCD within k iterations. 


C- Outline 

We will first show that without loss of generality we can assume 7 to be of Manhattan-type and that around any such 7 
there exists a collision-free e-tunnel with a finite covering by e-balls. We will then show that in each iteration of the outer 
while loop, <a> will break after a bounded number of iterations k^. Consequently, the total number of iterations of PCD 
— k — and therefore also the total number of random samples drawn in <b> will go to infinity unless the path planning 
query is solved before. We will then show that in each iteration of PCD and for any e the probability of finding a sample in 
an e-tunnel around 7 in <b> is bounded from below. Thus, the expected number of samples in this tunnel and — due to the 
finite covering — also the expected number of samples in a single e-ball will go to infinity with k. By showing that for e 
small enough the probability that the number of samples found in a single e-ball grows unboundedly is zero we will conclude 
that PCD is probabilistically complete. 

D. Proof 

Proposition 1: If there exists a continuous path 7 connecting gstan with qgoai then 

lim Psucc{k) = 1 . 

k—foo 

In other words; If there exists a continuous feasible path connecting the start configuration with the goal configuration, 
the a priori probability that PCD will have found it after k iterations approaches one with k going to infinity, i.e., PCD is 
probabilistically complete. 

We start proving probabilistic completeness with some basic observations regarding 7 . We will then step by step follow the 
outline given above and conclude the correctness of Proposition [1] in the end. 

We can assume 7 to be of Manhattan-type. Around 7 there exists an e-tunnel with a finite covering by e-balls: 

We will first recall the standard definitions for e-balls and e-tunnels. We then show that for any I G [0, L] around 7 (/) there 
exists an e-ball contained in Cftee and there exists even an e such that the entire e-tunnel around 7 is contained in Cfree- From 
there we show that 7 can be assumed to be of Manhattan-type — consisting of sub-paths each parallel to a coordinate axis. 
For Manhattan-type 7 we then show that any e-tunnel has a finite covering by e-balls. 

Definition 3 (e-ball): The set B'^{e,q) = {q' G ClUg — g'Hoo < &} is called an open e-ball around q. In the following we 
use the short notation Bg{q) for an n-dimensional e-ball and Bf^{q) for any m-dimensional e-ball with m < n around q 
according to the cxc-norm. For i?™(0) as frequently used in the definition of sumsets we simply write B™. Closed e-balls are 
obtained by relaxing the strict inequality used to define the corresponding open e-balls. 

Please observe that since we use the oo-norm, the ball has the shape of an n-dimensional hypercube. 

Lemma 1: For each collision-free configuration qf there exists an e > 0 such that all configurations in the ball B^i^qf) are 
collision-free. 
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(a) e-tunnel around 7 (b) Enlargement 

Fig. 1. Configuration space C with two disjoint obstacle regions (blue, bounded by dotted lines); e-balls Be{^{l)) around selected configurations along 
the path (dashed squares); (a); start and goal configuration (*); continuous feasible path 7 (solid black line); shaded rectangle shown enlarged in (b); (b); 
continuous feasible path 7 (solid gray line); Manhattan path obtained by construction according to Lemma (solid black line) 


Proof: Cfree IS Open. By definition of open sets, around any point of an open set there exists an entire £-neighborhood of 
points entirely contained in the set. ■ 

Definition 4 (e-tunnel): The set Tf = Uzg[o l] C Cfree is called an s-tunnel around 7 . 

Lemma 2: If there exists a continuous path 7 C Cfree connecting qstart with qgoab there exists an £ > 0 with \/e with 

£ > £ > 0, C Cfree. 

Proof: 7 is in Cfree which is open. Thus, for every I G [ 0 , L] there exists an s with Bg(j(l)) C Cfree- Since 7 and Cobst 
are closed and bounded sets, the extreme value theorem states that the continuous function f(l) = minq^gc^^^,(||7(Z) — gelloo) 
attains its minimum on I G [ 0 , L], Thus, with e = min;g[o_i]/(/) and £ > £ > 0 it holds \/l G [ 0 , L], i?e(7(Z)) C Cfree, 
since G Cobst with q^ G Bg{'-f{l)) would imply ||7(Z) — gdloo < £ < £ which contradicts i = min;g[o_i] /(/)■ It follows 
Tf = Uze[0,L] C Cfree- ■ 

Lemma 3: If there exists a continuous path 7 C Cfree connecting gstart with qgoai, there exists a continuous path 7 Man C Cfree 
that is of Manhattan type, i.e. it connects qstart with t/goai by a sequence of sub-paths that are each parallel to a coordinate axis. 

Proof: Around any continuous path 7 there exists a collision-free £-Tunnel. Now select the following £-balls bf. 


h=0 

bi = Bs{j{li)) 

A = {l\k < I < L,Vl' with I < I' < L,-f{l') i 6,} 
if ^ 0 li+i = minCi 
else d+i = L, stop here 

The first ball is centered at gstan- Each next ball is placed at the configuration where 7 leaves the current ball. If 7 contains 
loops or tight bends and has several fragments intersecting with the current ball, the next ball is placed at the configuration 
where 7 leaves the current ball for the last time. If the current ball bi contains (jgoai, £* is empty and a final ball is placed at 

9 goal - 

Consecutive balls overlap since for all but the last ball the center of is a boundary configuration of bi. Obviously, 

for all but the last ball d+i > h e. Thus, at most /cMan < Lj^ + 1 £-balls can be chosen according to this scheme. Now 

connect the centers of subsequent balls by a shortest Manhattan sub-path 7^^^^ of length L* with finitely many corners 
and 7Man(0) = 7Mag(-^*) = lih-i-i), 7Man C U &i+i. The concatenation of all these sub-paths gives a Manhattan path 

7 Man c Cfree of length £* Connecting q^tan with q^^ai- ■ 

As a consequence we can assume without loss of generality that 7 was of Manhattan type. Figure [T] shows an example of 

how an existing path 7 also implies the existence of a Manhattan path 7Man- 

Lemma 4: If 7 is of Manhattan-type, any Tf can be covered by a finite number Iccov of £-balIs, i.e. Tf C Be ( 7 (d))- 
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Fig. 2 . Cell K with collision-free sample qf and its split sectors S’‘~ {qi) (very light red), (light red), S^~{q{) (very light green), and S^^{q[) (light 

green) bounded by dashed lines where i and j are the horizontal and vertical dimensions, respectively. A C-space obstacle (shaded darker, bounded by dotted 
line) intersects with and S^+. (g) = {q' G K\q^ < qi, di{q, q') > dj {q,q') '^j 7^ 1 < i < n}. A colliding sample found in (qf) leads to a 

vertical split perpendicular to dimension i. 


Proof: For any e > 0 we can construct an e-tunnel using a finite number of e-balls, proving equality in the relation above. 
Place e-balls at the start and goal configuration and at every corner of the Manhattan path. Then, for any straight-line segment 
in 7 that is longer than e, place e-balls at intervals of e. With fccor corners in 7 Man it holds fccov < 2 -|- kcor + Lje. ■ 

The number of samples in at least one e-ball around 7 grows unbounded with the number of iterations of PCD: 

We will first show that in each iteration of PCD <a> returns after a bounded number of iterations fca and thus the number 
of iterations of PCD — k — goes to inhnity. We will then show that in each iteration of PCD at least one possibly occupied 
cell is sampled that intersects with 7 and that the probability of finding a sample in an e-ball around 7 is bounded from below. 
Thus the number of samples in an e-tunnel around 7 grows unbounded and from the existence of a hnite covering of the 
e-tunnel by e-balls we conclude that the number of samples in at least one e-ball around 7 grows unbounded with fc, too. 

Definition 5 (Split sectors): The set 

S\q) = {q' e K\d^(^q,q') > dj{q,q') 'ij <n} 

is called the f-th split sector of a sample g in a cell k. The split sector grows from q in both directions (±). By S'^^{q) = 
{q' G S^(^q)\q'^ > qi} and S^~{q) = {q' G S'^{q)\q[ < qi] we denote the one-sided f-th split sectors. 

See Figure |2] for an example. Whenever a colliding sample is found in a possibly free cell or a collision-free sample is found 
in a possibly occupied cell, this cell is marked as mixed and split into possibly free and possibly occupied cells. The cell is 
split in the middle between the newly found wrong sample and the closest old sample. To maintain rectangloid cell shape the 
cell is split perpendicular to a coordinate axis. In the basic version of PCD the cell is split perpendicular to the dimension 
of largest distance to the nearest sample of conflictive type. Thus, the cell is split perpendicular to the f-th dimension, if the 
new sample is found in the f-th split sector of the nearest old sample. According to the definition above, conhgurations on the 
boundary belong to more than one split sector. For this proof, the decision perpendicular to which dimension to split in this 
case is of no importance. 

Lemma 5: In one iteration of PCD, in <a> a cell can get split at most a bounded number of m times. To be more precise, 
the cell is split into one possibly free and one possibly occupied cell and the new possibly free cell can get split at most m — 1 
times. 

Proof: In <a> colliding samples may be found while checking a continuous path through a channel of possibly free cells. 
Each possibly free cell holds exactly one collision-free sample. A colliding sample found in a possibly free cell leads to a cell 
split. Please recall that a rectangloid cell k is dehned by an upper and a lower dehning vertex c“ and c|,, respectively. We 
omit the cell index k where the respective cell is nonambiguous to ease notation. Please consult Figure [3] for a sketch of the 
following reasoning. 

Let Eq^ be the radius of an e-ball around the collision-free sample qt G k with Bg^^i^qf) C Cfree- Take any dimension i < n. 
The distance in dimension i between the collision-free sample qf and the upper cell boundary c“ is denoted by = di(c“, qf), 
accordingly for the lower cell boundary c*; D\ = di{c^,qf). If a colliding sample q^ is found in this cell while checking a 
continuous path for collision, the cell has to be split into a possibly free cell and a possibly occupied cell. 
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Fig. 3. Cell K. with collision-free sample and its split sectors (dashed lines). A C-space obstacle (blue, bounded by dotted line) intersects with S'^~ and 
S^'^. After a colliding sample has been found in while checking a continuous path in <a> the cell is split horizontally (red line, 1). A second 

colliding sample q^ found in the next iteration of <a> leads to a second horizontal split (red line, 2). A colliding sample q^ found in S'^~{qf) in the third 
iteration of <a> leads to a vertical split (red line, 3). After these three splits no more splits are possible since the split sectors of qf in the remaining free cell 
do not contain any colliding configurations. The maximum number of splits possible in one iteration of PCD is determined by the position of in k and the 
size of the lai'gest e-ball of collision-free samples surrounding it. 


For the split to happen in dimension i, must be found in the i-th split sector of qf, i.e. it has to hold di{qf, qc) = j®. —qci \ = 
maxj dj{qf,qc). A colliding sample q^ found in S'®+(gf) or S'^~{qf) leads to an upper split or a lower split, respectively. We 
present the argument for upper splits only. It holds accordingly for lower splits. 

After one upper split due to a sample q^ in the i-th split sector of qf the i-th coordinate of the upper boundary of the 
remaining possibly free cell becomes = qf^ + di{qf,qc)/2. The variable with index old refers to the value before any 

split was done according to this lemma, new refers to the latest value. Consequently, = di{qf,q^)/2 < and 

after the mth upper split in direction i it holds At the latest when there are no more 

upper splits possible as di{qf,qc) = maxj dj{qf,qc) < contradicts q € Cfee for all q € {qf). Thus, after at 


most m“ = 


(logf?r“-log%)/log2 


upper and m\ = 


-\ogeg,)/\og2 


lower splits there are no more splits 


possible in dimension i. With m = lemma holds. After at most m splits, the remaining possibly free cell 

K is entirely contained in Cfree- ■ 


Lemma 6: In each iteration of PCD, <a> returns after a bounded number of iterations k^. 

Proof: This is a direct consequence of Lemma |5] In the first iteration of <a> — ka = 0 — let there be fepUee possibly 
free cells, each containing only one collision-free sample. Collision-free samples found while checking a continuous path for 
collision in <a> are not stored so the number of collision-free samples stays constant through all iterations of <a> and equals 
kpfree- In each iteration of <a> either a continuous path is shown to be collision-free and success is returned or a colliding 
sample is found and a cell has to be split. Lemma |5] gives an upper bound on the number of possible cell splits per cell and so 
the total number of possible cell splits in <a> is bounded by mubound = Sfe=i where rrik is the bound from the preceding 
lemma for cell 

Thus, if the while loop does not break before, after at most mubound splits all fcpbee possibly free cells are entirely contained 
in Cfree- Consequently, if a cell path can be found, the continuous path through these cells is collision-free and success is 
returned. Otherwise, if no cell path can be found, the while loop <a> breaks. ■ 


Lemma 7: In each iteration of PCD, in <b> at least one cell Kpocc is sampled, that contains a fraction of 7, i.e. there exists 
a possibly occupied cell Kpocc and an I G [0,L] such that ■^{1) G ttpocc- 

Proof: In <b> all possibly occupied cells are sampled. Thus we have to show that at least one possibly occupied cell 
intersects with 7. Cells are closed sets. The union of all (finitely many) possibly occupied cells iCpocc = Ukga:pocc ^ hence 















also closed and the set A = C \ ifpocc is open. If for no I € [0, L] 'y{l) is contained in a possibly occupied cell (inside or on 
the boundary) then \/l G [0,L] 7 (Z) € A which is open and possibly free. But then there exists an e > 0 with C A. The 
continuity of 7 and thus of and the strictly positive diameter of lead to the existence of a series of possibly free cells 
where consecutive cells are adjacent and share a boundary with nonzero The cells (p = {k|k G /Cpfree, G [0, L]j{l) G k} 

connect the start cell with the goal cell and form a cell path when brought in the right order. Thus, if there is no such cell 
path, there has to be an Z e [0,L] and a possibly occupied cell Kpocc with j{l) G Kpocc- ■ 


Lemma 8: In each iteration of PCD, the probability of hnding a sample in an e-tunnel around 7 is bounded from below. 


Proof: It was shown in the previous lemma that when entering the sampling step <b> at least one cell k along 7 is 
possibly occupied. Since all possibly occupied cells are sampled in <b>, one sample is taken in this cell according to a 
uniform distribution. Thus, the probability of hnding a sample inside the e-tunnel around 7 in this cell is 


P{q G Tf) 


fj.{K n Tf) ^ fi{Kr\B^{-f{i))) 
p{k) ~ p{k) 


for any I with 7 (() G k. 


In words: The probability is given by the fraction of the volume of the intersection of the e-tunnel with the cell and the volume 
of the whole cell. This fraction is larger or equal to the fraction of the volume of a single e-ball around ^{l) intersected with 
K and the volume of the cell since the e-ball is a subset of the e-tunnel. For the rest of this proof we denote this intersection 
K n Bs{'j{l)) with I. 

The n-dimensional Lebesgue measure of the rectangloid cell k is given by ii{k) = n"=i Of = (ii(c*,c“). The 

intersection I of k with the e-ball around 'y{l) is also rectangloid and its measure is given by = ]f[f Df, D( defined 
accordingly with Df > e if and only if Of > e. Please recall that C = [0,1]". So, obviously, it holds that Of < Of = 1. But 
now if Of > e, then Of > e and ^ If Of < e, then Of = Of and thus ^ = 1 > 7^. Consequently, 


P{q G Tf) > 


P{I) 

fi{K) 


nr=iOf ^m(c) 


> 


= e 


which is independent of the actual cell k and therefore suitable as a lower bound. ■ 

Figure |4| shows a 2D example. A possibly occupied cell k contains a segment of 7. The probability of hnding a sample in 
Tf is larger or equal to the probability of hnding a sample in a single £-ball around 7 (Z) for j{l) G k. When sampling the 
possibly occupied cell, this probability is equal to the fraction of the measure of the intersection of the ball with the cell and 
the measure of the cell. As shown above, this fraction is bounded from below and, consequentially, the probability of hnding 
a sample in the £-tunnel is bounded from below. 

Lemma 9: For a specihc cell k the lower bound on hnding a sample in an e-tunnel around 7 derived in Lemma 0 can be 
increased to 

P{q e Tf) > 


where fcwid is the number of dimensions in which the cell has a width of £)f < e. 
Proof: This follows directly from 


P{q G Tf) > 


P(I) UtiDi 


and from the reasoning shown in the proof of the preceding lemma together with the fact that £)f = £)f for £)f < £. 


Lemma 10: With the number of iterations of PCD going to inhnity, the expected number of samples in any £-tunnel grows 
unbounded. 

Proof: According to Lemma [Tj in every iteration of PCD at least one possibly occupied cell is sampled that intersects 
with 7 and hence intersects with Tf. Lemma |8] showed that the probability of hnding a sample inside Tf is bounded from 
below. Therefore, with the stochastic variable being the number of samples found in the £-tunnel after k iterations of PCD, 
its expected value is bounded from below by 

EiM) > ke- 


which goes to inhnity with k. 


Lemma 11: With the number of iterations of PCD going to inhnity, the expected number of samples inside at least one 
£-ball around 7 grows unbounded. 

Proof: Lemma |4| states that any Tf can be covered by a hnite number /ccov of £-balls. Thus, in at least one £-ball the 
expected number of samples is larger or equal to the expected number of samples in Tf divided by fccov According to Lemma 
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Fig. 4. Possibly occupied cell (black box) intersecting (gray-shaded box) with an e-ball (dashed box) around a configuration on the path (bold line) 7 (/) 
(black circle); Cobst- blue, bounded by dotted line 


[TOl the expected number of samples in T'^ grows unbounded. Therefore, in at least one of the £-balls of the finite covering of 
the expected number of samples grows unbounded. ■ 


The probability that the number of samples inside an e-ball goes to infinity is zero 

We have shown so far that if the path planning query is not solved before and k goes to infinity, the expected number of 
samples in at least one e-ball grows unboundedly. We will show in the following that the probability of this to happen is zero. 
We will first prove that around any collision-free sample there exists a neighborhood that will never again be contained in a 
possibly occupied cell. The neighborhood is cleared. We will then define a subset of an e-ball — i.e. its intersection with cells 
holding a fraction of the path — and show that even in at least one of these pruned e-balls the expected number of samples 
would grow unboundedly with k if the path planning query does not get solved before. For these pruned e-balls we will then 
show that if there exists a continuous path 7 , the probability of finding an unboundedly growing number of samples in the 
pruned ball is zero. We will prove that when more and more samples are found in a pruned e-ball around 7 , the probability 
that the entire pruned e-ball gets cleared around 7 approaches 1. At the latest when all pruned e-balls of the finite covering 
of a pruned are cleared, the path planning query is solved. 

Definition 6: A collision-free configuration is called cleared if it will never again be contained in a possibly occupied cell. 
A subset S C Cfree is called cleared if its interior will never again be contained in a possibly occupied cell. Accordingly, a cell 
K is called cleared if its interior will never again be contained in a possibly occupied cell. A cell is called cleared around 7 
for £ if the interior of its intersection with Tf is cleared. 

The limitation to the interior of sets is necessary to ease notation later on because configurations on the boundary between 
cells belong to both cells and can be cleared in one cell but not in the other. If all cells intersecting with such a boundary 
configuration are cleared also the boundary configuration is cleared. 

Lemma 12: Around any collision-free sample there exists an open neighborhood that is cleared, i.e. it will never again be 
contained in a possibly occupied cell. 

Proof: A collision-free sample must be contained in a possibly free cell. A possibly free cell is split only if a colliding 
sample is found in this cell. As shown in the proof for Lemma |5] in any dimension the closest colliding configuration in the 
respective split sector determines the closest possible split in this dimension. See Figure |5] for an example of a collision-free 
sample qf and the closest possible splits determining a neighborhood around qf that is cleared. Here it is important, that we 
store only one collision-free sample per possibly free cell. If there were more, a split between one collision-free sample and a 
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Fig. 5. Possibly free cell with a collision-free sample (black circle); Cobst (blue, bounded by dotted line); split sectors (dashed lines); closest colliding 
configuration in each sector (black squares); open neighborhood that will never again be contained in a possibly occupied cell (grey box). If a colliding sample 
would be found at the cell would be split at the red line. Accordingly for the closest colliding configurations in the other split sectors. The closest possible 
splits define the cleared region in the center that will never again be contained in a possibly occupied cell. 



Fig. 6. Possibly free cell k with a collision-free sample q^ (black circle) found in an e-ball (small dash-dotted rectangle) around 7 (bold black line); Cobst 
(blue, bounded by dotted line); relevant split sector (shaded gray bounded by dashed lines); According to Lemma [Tsl if there exists an e-tunnel around 7 , then 
any collision-free sample found in an e-ball around 7 with e = e/5 clears the entire intersection of the e-ball with k. If then a colliding sample qc would be 
found just outside the e-ball (large dash-dotted rectangle) as shown in the figure, the closest possible split (red line) would lie just outside the e-ball. Thus, 
the entire e-ball is cleared. 


colliding sample could be arbitrarily close to another collision-free sample. All configurations within the rectangloid defined 
by the closest possible splits according to the respective split sectors will never again be contained in a possibly occupied cell. 


Lemma 13: There exists an 5 > 0 such that for all 5 > £ > 0 a sample found inside an e-ball around 7 clears the entire 
intersection of the e-ball and the respective cell that was sampled. 

Proof: Take e = sup{e | Tf G Cfree} as the maximum e such that for all e < e the e-tunnel around 7 is still entirely 
contained in Cfree and take e = e/5. Then for any with e > e > 0 it holds: If a collision-free sample qf G 

is found, then in any split sector of qf and any direction (zb) the distance between the collision-free sample qf and the closest 
colliding sample qc is not less than 4e and thus no less than the double distance between qf and the boundary of the e-ball in this 
direction. But then the closest possible split cannot cut through the e-ball and hence all configurations within the intersection 
of B^{'j{l)) with the respective cell will never again be contained in a possibly occupied cell. ■ 
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D'^=Dk28 

1 1 


Fig. 7. e-ball (thin dashed line shaded light gray) intersecting with several cells (black contours); the pruned e-ball Be (bold dark gray dashed line shaded 
gray) is given by the intersection of the e-ball Be('^{l)) with all cells intersecting with the path 7 (bold line) in Be', Cobst- blue, bounded by dotted line 


In the following we assume e < e/5 for any e-ball around 7 and keep in mind e = e/5 as the upper bound in terms of 
this lemma. Figure shows an example for a collision-free sample qf found in the upper left corner of an e-ball around 7 . 
A colliding sample is found in the downward pointing split sector of qf. Hence, the cell is to be split horizontally in the 
middle between qf and q^. From e = e/5 it is guaranteed that any colliding configuration has a minimum distance to qf of at 
least 4e in any dimension. Thus, it is guaranteed that the split will not cut through the e-ball. 

Lemma 14: There exists an e such that for all e > e > 0 and VZ S [0,L], contains either a single straight line 

segment of the path or a single corner connecting two straight line segments. 

Proof: From the construction of 7 Man it has finite length L, finitely many corners fccor and no loops or tight bends. But 
then it consists of also finitely many straight line segments. Let the shortest one have length L™” > 0 such that each sub-path 
between two corners is a straight line segment of length Li > L™". Then any e-ball i?e( 7 (Z)) with L ™-'^= e > e > 0 
contains either a straight line segment or a corner connecting two straight line segments and the fraction of 7 that intersects 
with is not greater than 2e. ■ 

In the following we assume e < e for e-balls around 7 . 

We now would like to show that all e-balls of the finite covering of the e-tunnel get cleared when the number of iterations 
of PCD goes to infinity and conclude that PCD is probabilistically complete. However, we have shown so far that at least 
one cell intersecting with 7 is sampled in each iteration of PCD — instead of one cell intersecting with an e-ball or e-tunnel 
around 7 . For these cells we have then bounded the probability of finding a sample inside the e-tunnel. So we have no bounds 
on probabilities for samples in cells that intersect with the e-ball around 7 but not with 7 itself. For the following analysis we 
therefore have to draw on pruned e-balls and pruned e-tunnels as defined below. 

Definition 7 (Pruned e-ball): The set Bg('y(^l)) fl Ukek: ^ 075^0 ^ called the pruned e-ball around 7 and denoted by 
B^{'-f{l)). It is the intersection of a standard e-ball with the union of all cells intersecting with 7 . See Figure [T] for an 
example. 

Definition 8 (Pruned e-tunnel): Accordingly, the pruned e-tunnel is obtained by the union of all B^ for B^ in the finite 
covering of Tf. 

Definition 9 (Inner cells, lower outer and upper outer cells): A cell k intersecting with 7 in a pruned e-ball b is called an 
inner cell of b if for = min{^|^ € [ 0 ,L], 7 (Z) € k} and l^^^ = max{Z|Z G [ 0 ,L], 7 (Z) G k} it holds 7 (Zmin) S b and 
lilmux) € b. If either 7 (Zmin) ^ b 01 j(lmax) ^ b, K is called an outer cell of b. For being able to be precise later in the proof, 
we have to distinguish between lower and upper outer cells. An outer cell n is called lower outer cell if 7 leaves 6 in k 
through cf or upper if it leaves b through cj“. The case that k spans the ball and neither nor /max is in b is not relevant 
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for the following. 

For example, the pruned e-ball b in Figure [T] has two inner cells and two outer cells, one lower outer cell at the left edge 
and one upper outer cell at the right. 

Lemma 15: Lemmas fOl and fT4l hold also for pruned e-balls. For e < e according to Lemma [TS] Lemmas 0 - [TT] hold also 
for pruned e-balls and e-tunnels. 

Proof: For Lemma [13] The intersection of the e-ball and the cell that was sampled equals the intersection of the pruned 
e-ball and this cell. Thus, the same argument holds also for pruned e-balls. 

For Lemma fT4l Since by dehnition of pruned e-balls = i?£( 7 (/)) (" 17 , the Lemma holds also for pruned e-balls. 

For LemmaO Again, the lower bound was derived from a cell k intersecting with 7 and an e-ball Bg{'y{l)) with j{l) € k. 
Thus, the result holds also as lower bound for the pruned e-ball. Accordingly for Lemma 0 

For Lemma [To] First we notice that the volume of a pruned e-ball might decrease when a cell is split and one of the two 
new cells no longer intersects with 7 . However, for e < e the number of samples in this pruned e-ball will never decrease 
since a sample q € kCi Bi;{'y{l)) clears the entire intersection of the ball with the cell. Thus there cannot be a split through 
this intersection with one new cell possibly not intersecting with 7 . Since the probability of hnding a sample in a pruned e 
ball in any iteration is bounded from below and since q G for some Z S [ 0 , L] => q S T^, the expected number of 

samples in any pruned e-tunnel grows also unbounded. 

For Lemma [TT] From the construction of the pruned e-tunnel it has a hnite covering by pruned e-balls and consequentially 
the expected number of samples in at least one pruned e-ball grows unbounded. ■ 

Consequently, it is sufficient to show that neither a pruned e-ball containing a straight line segment nor a pruned e-ball 
containing a corner of 7 can be sampled arbitrarily often without clearing the pruned e-ball. For both cases we will show that 
when the number of samples in such a pruned e-ball grows, the probability that the entire ball is cleared approaches one. 

We will hrst take a look at cells and pruned e-balls that contain a straight line segment of 7 . Later, we will extend these 
results also to pruned e-balls containing a corner of 7 . 

Definition 10 (Traversing dimension): For a cell or pruned e-ball intersecting with a straight line segment of the Manhattan 
path only, we call the dimension whose axis runs parallel to the path segment the traversing dimension. 

Since, according to Lemmas [T3] and [T5| a sample inside a pruned e-ball B clears the entire intersection of the ball and the 
respective cell, the only way for the ball to contain more than one sample is to intersect with several cells. At any time there 
also has to be at least one cell intersecting with the ball that has not yet fetched a sample in B. Consequentially, if the number 
of samples is to go to inhnity, the number of cells it intersects with has to grow unbounded to. The number of cells that 
intersect with the pruned ball can only grow, if a cell that already intersects with the e-ball is split in the traversing dimension 
i. A split in any other dimension leads to two cells, one of which does not intersect with 7 and has to be excluded from the 
pruned e-ball. Thus, after a split in any other dimension than i, the number of cells intersecting with the pruned e-ball stays 
constant. 

In any of these cells that already contain a sample in the pruned e-ball the entire intersection of the pruned e-ball with the 
cell is cleared. Hence, for the ball to be able to be sampled again, there have to be cells that have not been cleared yet that 
intersect with the pruned e-ball. For the number of samples to grow unbounded, the number of potentially to be sampled cells 
may never decrease to zero. Once a sample has been found in each cell in B the entire pruned ball is cleared. 

We will show that there exists an e > 0 such that when a cell intersecting with the pruned e-ball is sampled, the probability 
that the cell is split in the traversing dimension is less than the probability that the intersection of the pruned e-ball with the 
cell is cleared. 

We will now investigate what might happen if such a cell is sampled. The sample found can either be colliding or collision- 
free. To be sampled in <b> the cell obviously has to be possibly occupied. 

colliding If the sample is colliding, the cell is still possibly occupied. Even though we know that it intersects with 7 and 
cannot be entirely occupied, the algorithm has found only colliding samples inside so far. So for PCD it is still possibly 
(entirely) occupied. We now just have another colliding sample in this cell. Since we do not assume to know anything 
about the other colliding samples found before, we do not care about this sample either. Since the sample found in a 
possibly occupied cell is colliding, no cell is split and the number of cells that could possibly fetch a sample in the pruned 
e-ball is not affected. 

collision-free If the sample is collision-free, k is mixed and has to be split into possibly occupied and possibly free cells. Since 
we do not assume to know anything about the location of colliding samples, we investigate the possible splits according to 
the location of the collision-free sample. To bound the number of splits in the traversing dimension, we assume colliding 
samples to be found in the worst possible places. 

Please recall that <a> is completely deterministic and produces colliding samples only. The collision-free samples found 
in <a> while checking a continuous path through possibly free cells are not stored and will not have any impact on the 
further solution process. Since <a> is deterministic we cannot assume a uniform or any other stochastic distribution of the 
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colliding samples generated in <a>. We therefore show that even in a worst case where colliding samples are found at the 
most unfavorable locations, the number of samples in an £-ball cannot grow unbounded. 

A collision-free sample found in a cell intersecting with a pruned £-ball around 7 in <b> leads to one of the following 
splits; 

split in traversing dimension A split in the traversing dimension gives rise to two cells both intersecting with 7 and hence 
with the pruned £-ball. Only splits in the traversing dimension give rise to more cells intersecting with the pruned e-ball. 
Thus, if the number of splits in the traversing dimension can be bounded, we can also bound the number of samples in 
the pruned e-ball. 

split in non-traversing dimension If the collision-free sample leads to a split in a non-traversing dimension, 7 will after the 
split either intersect with one possibly free cell or one possibly occupied cell. The other cell arising from this split does 
not intersect with 7 in the e-ball and its interior does hence not intersect with the pruned e-ball. The number of cells 
intersecting with 7 and hence with the pruned e-ball stays constant, 
clearing split A special form of the non-traversing split is the clearing split that arises from a sample found within an e-ball 
around 7. The entire intersection of the e-ball with k is cleared, i.e. the new possibly free cell is cleared around 7 and 
will never again be split through the e-ball - especially not in the traversing dimension. The remaining possibly occupied 
cell does not intersect with 7 in the e-ball and its interior does hence not intersect with the pruned e-ball. The number of 
cells that could possibly fetch a sample in the pruned e-ball in future decreases by one. 

Here, we can identify a monotonous progress in solving the path planning query: more and more fractions of the path get 
cleared and will never again be contained in a possibly occupied cell. If PCD could not hnd a collision-free continuous path 
before, at the latest when all fractions are cleared, the path planning query is solved. 

We will now identify probabilities for the events above. In particular, we will bound the probability of a good sample - 
clearing the entire intersection of the pruned ball with the cell - from below. Then we bound the probability of a bad sample 
- potentially leading to a split in the traversing dimension through the pruned ball - from above. By showing that this upper 
bound goes to zero with e ^ 0 while the lower bound does not decline, we conclude that there is an e where the probability 
of a good sample exceeds the probability of a bad sample. 

There exists an e such that the probability that the number of samples in a pruned e-ball goes to infinity is zero.: 

We have shown in Lemma [14] that for e small enough a pruned e-ball holds either a single corner or a straight line segment 
of the path 7. The number of corners of 7 k^or returned from the algorithm presented in Lemma is arbitrary but hxed and 
independent of the choice of e for the following analysis of e-balls. Thus, when we let e go to zero, the number of pruned 
e-balls from the hnite covering of 7 that hold a single corner stays constant while the number of pruned e-balls that hold a 
straight line segment of 7 increases. 

Let e be smaller than e of Lemma [T3| Thus, a sample found in the pruned e-ball clears the entire intersection of the sampled 
cell with the pruned e-ball. 

We start with showing that there exists an e such that when an inner cell of a pruned e-ball is sampled, the probability of 
hnding a good sample — clearing the entire intersection of the pruned e-ball with the sampled cell k — is larger than the 
probability of hnding a bad sample — potentially leading to a cell split in traversing dimension. We then extend this result to 
outer cells of a pruned e-ball. 

We will hrst show, that the probability of hnding a good sample Pgood(K) is bounded from below independent of the actual 
cell K that is sampled and independent of the size of the pruned e-ball. A good sample clears the entire intersection of the 
pruned e-ball with k. 

Lemma 16: Whenever an inner cell k of a pruned e-ball with e < e is sampled (e as seen in the result of Lemma [TsTl. the 
probability of hnding a good sample Pgaodin) clearing the entire intersection of k and is bounded from below independent 
of K and independent of the actual choice of e. 

Proof: This follows directly from Lemmata 0 and [13] The lower bound is 

-Pgood(K) > e”. 

For an inner cell of B^ we see that in traversing dimension i it holds = Dj in terms of the proof of Lemmata [^ and ]9] 
and consequentially the lower bound can be raised to 

f’good(K) > 


Lemma 17: Whenever an inner cell k of a pruned e-ball Bg with e < e is sampled, the probability of hnding a bad sample 
Pbadin) potentially leading to a split of k in traversing dimension is bounded from above. This upper bound goes to zero with 
the cell width of k in traversing dimension for all but a hnite number of cells. 
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Fig. 8. (a): A|^ is the projection of A (light blue set) onto the (n — l)-dimensional subspace perpendicular to the 2-th dimension, (b): A|^. is the (n — 1 )- 

dimensional cross section of A through Xi (dashed black line) perpendicular to the 2-th dimension, (c): is the projection of the 2 £-wide cross section 

of A through Xi perpendicular to the 2-th dimension. 


To prove Lemma [TT] we first have to introduce some more useful notation. We then bound the volume where such a bad 
sample may appear and show that the probability of sampling in this volume goes to zero for all but a finite number of inner 
cells K. 

For a set A S R" let A^. denote its projection onto the (n — 1)-dimensional subspace perpendicular to the i-th dimension, i.e. 

A|. ={x& &A,x= {x\,.. .,x'+i,x^)} . 

Let Aj. ^ or shorter A\^ denote its {n — 1)-dimensional cross section through Xi perpendicular to the i-th dimension, i.e. 

K”"^|3x' €A,x'i= Xi,x= (x'l,.. .,x-_i,x'+i,x;,)} . 

Let furthermore A\^ ^ or shorter A^^ be defined by 

G R’*“^|3x' e x4,x' G [xi -e,Xi + £],x = (x'l,...,x'_i,x'+i,x^)} . 

^|x ±e could be described as being the (n — 1)-dimensional projection of the 2e-wide cross section through Xi perpendicular to 
the f-th dimension. Instead of A^^ we sometimes use the notation Aj^^ ^ later on. Please see Figure^for an illustration 
of the three projections. 

Lemma 18: If x4 is a compact semi-algebraic set, also A^., A^^ and x4|^ are compact semi-algebraic sets. 

Proof: The Tarski-Seidenberg theorem (see, for example, El for reference) states that semi-algebraic sets are closed 
under projection. Hence, A^. is semi-algebraic. The canonical projection R" —> R"“^ is a continuous map and hence the 
image of any compact set is compact. 

x4|^ = (x4 n {x' G R"'|/(x') = x' — Xi = 0})|^ is the projection of the intersection of two semi-algebraic sets. Hence, it is 
semi-algebraic. The set {x' G R"'|/(x') = x' — Xi = 0} is closed in R" and the intersection of a closed and a compact set is 
compact. Since the canonical projection of a compact set is compact, A\^ is compact in R"“^. 

^\x-±e = (^ n {x' G R"|/(x') = x' — (xi — s) > 0,g{x') = x' — (xi -|- e) < 0})|^ is the projection of the intersection of two 
semi-algebraic sets. Hence, it is semi-algebraic, {x' G R^j/jx') = x' — (x^ — e) > 0,g{x') = x' — (x^ + e) < 0} is closed in 
R”. Following the argument directly above, x4|^ is compact in R"”^. ■ 

As a comment; Cobst and its boundary SCobst are closed and we are merely interested in the conservation of the closedness 
property. Since there are examples where the canonical projection of a closed set is not closed, we have to require compact 
sets A. Since Cobst C C = [0,1]”, Cobst and JCobst are not only closed but also bounded and hence compact. 

With the right tools in place we can now take a look at the bad samples that potentially lead to a cell split perpendicular to 
the traversing dimension of a cell. Please recall that we examine the position of collision-free samples found in the sampling 
step. For these we can assume a uniform distribution over the cell that is sampled. We do not assume to have any knowledge 
about colliding samples in the cell that is sampled. These can stem from both probabilistic sampling or from collision checking 
while checking a continuous path in the deterministic part of the algorithm <a>. Therefore, we make a worst case analysis 
and assume the colliding samples to be found in the worst possible places. Thus, if a collision-free sample is found that might 
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(a) Q (b) Upper bound on Q 

Fig. 9. (a): shows a possibly occupied inner cell of a pruned e-ball. The path 7 (bold black line) traverses k horizontally. Cobst (blue area); (5Cobst (dotted line); 
The set of bad configurations Q (grey area) is bounded by the boundary of n, <5Cobst the outer split sector boundaries (dashed grey lines), (b) depicts the 
derivation of an upper bound of this volume (dash-dotted rectangle). In traversing dimension i it simply covers the whole cell. In the hyperplane perpendicular 
to the traversing dimension it covers the projection of <5Cobst in ^ onto it, widened by a D^-ball and restricted to the projection of k,. The probability of 

finding a bad sample is smaller than the probability of finding a sample within this rectangle, so Pbad(«^) ^ - - -■ 


potentially lead to a split in the traversing dimension if a colliding sample is found in the wrong place, we assume this colliding 
sample to be found exactly there. 

If a collision-free sample qf shall potentially lead to a cell split in traversing dimension i, there has to exist a colliding 
conhguration in the i-th split sector of qf, S'^{qf). But if a colliding conhguration exists in the i-th split sector of qf then 
also at least one conhguration on the Cobst boundary has to exist in S'‘{qf). This leads to the following lemma: 

Lemma 19: An inner cell /t of a pruned £-ball can be split in the traversing dimension only if a collision-free sample qf is 
found with the i-th split sector of qf containing a fraction of the boundary of Cobst: Cl 5Cobst 7 ^ 0- 

Proof: By dehnition of the split sectors, a cell is split in any dimension i only if a colliding sample is found in the i-th 
split sector of a collision-free sample or if a collision-free sample is found in the i-th split sector of a colliding sample. Since 
a is in the *-th split sector of b is equivalent to b is in the i-th split sector of a, it is sufficient to examine the i-th split sector 
of qf only. For the cell to be potentially split in the traversing dimension, there has to be a colliding conhguration ® G k 
in the i-th split sector of qf. From the dehnition of the split sector we get for in >S'*(gf) also the straight line connection 
L — qf + t{qc — qf),t £ [0,1] of these two samples is in 5'*(gf). Hence also the point JCobst n L is in S^{qf). ■ 

Thus, a sample is bad only if its i-th split sector contains a fraction of the boundary of the C-space obstacles (5Cobst- But 
then from the symmetry of the split sector relation we get that the set of bad samples is the collision-free subset of the union 
of all split sectors originating at conhgurations on SCobst in k. 

Lemma 20: The set of bad conhgurations of an inner cell k of a pruned e-ball is given by Q = k n Cfree H U^ebCob iOk ■ 

Proof: This comes straightforwardly from the dehnition of a bad sample. It has to (a): be a conhguration of k, (b): it has 
to be collision-free and (c): its i-th split sector has to contain a fraction of (5Cob.st in k and by symmetry it has to be contained 
in the i-th split sector of a <5Cobst conhguration in k. ■ 

See Figure |3a for an example. The grey area corresponds to Q, the set of bad conhgurations. But now we can bound the 
probability of hnding such a sample from above. This derivation is depicted in 0b. 
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Lemma 21: Let n be an inner cell of a pruned e-ball with cell width in traversing dimension i. The probability of 
finding a bad sample in k can be bounded from above by 

Df X Ai""^(((^Cobst n k)|, 0 Blf) n K| J 


p” ^(((JCobst n k)|. © K|J 


i.e. the volume where a sample could lead to a split in the traversing dimension is not greater than the intersection of the 
boundary of Cobst with k projected onto the hyperplane perpendicular to dimension i and widened by an n — 1-dimensional 
Df-ball times the cell width in traversing dimension D^. 

Proof: Since k is an inner cell of the pruned £-ball B^ it has width Df < 2£ in the traversing dimension i. The i-th split 
sector of qf is given by S'^{qf) = {q\q € k, di{q — qf) > dj{q — qf), 1 < i j < n}. Thus, the distance between qf and any 
colliding sample q^ in the split sector in any other dimension than i must be not greater than the actual distance in dimension 
i which cannot be greater than Df. But then qf must have been found at a distance of dj < d i from a configuration on the 
boundary of Cobst which implies gf|. G (i5Cobst H k)\. © From qt G k it follows qf|. G ((i5Cobst H k)|. © fl k\.. ■ 

We now carry over the same argument to an outer cell of a pruned e-ball B^ where we get a very similar result. Here it is 
important that we want to bound the probability of finding a bad sample that not only splits the cell k in traversing dimension 
i but that this split also has to cut through Bg. Keep in mind that we want to bound the number of samples in B^ by showing 
that it will not intersect with more and more cells as PCD progresses. If the split cuts through k, in the traversing dimension 
but not through B^^ the number of cells that intersect with B^ simply does not change. Please see Figure fTOl for a sketch of 
the derivation of the upper bound for an outer cell. 

Lemma 22: Let k be an upper (lower) outer cell of a pruned e-ball Sg with the intersection / = k n 5g having width Df 
in traversing dimension i. The probability of finding a bad sample qf in k that potentially leads to a cell split in traversing 
dimension cutting through Hg can be bounded from above by 


Pb^LdiK) < 


min(2Df, Df) X /r" H((^Cobst n k)| 


<b: 


2D; 


')n«u) 


/i(K) 


with c“ being the Lth coordinate of the upper defining vertex of B^, c“ (replaced by c\ for a lower outer cell). Thus, in 
dimension i, the sample may be found in the intersection / or at a maximum distance of the width of this intersection outside 
Be. 

Proof: If the potential split shall cut through Be in traversing dimension i, q^ has to be found on one side of the split and 
a colliding sample q'^ on the other side at the same distance. This limits the area where q^ could be found to [c“ — Df, c“ + Df] 
in dimension i. gf > c“ — Df is obvious from q^ G k. For the upper bound we get: For any colliding sample q^ in k it obviously 
holds q) > c'l — Df. But then, if gf > c“ + Df for the split location it holds = (gf + gf)/2 > c“ which is outside the 
intersection I. Thus, gf < c“ + Df and consequentially, the width of the volume where a bad sample might be found is less 
than 2DJ. If the width of k in dimension i is smaller than 2Df, the width of the volume where a bad sample might be found 
is Df. 

Following the same argument as in the proof of Lemma EU in the other dimensions the volume can be bounded by 
(((5Cobst n /c)| © Bff~}) n K| J. Please observe that the projection of JCobst in the relevant area is widened by a 2Df-ball. 

Accordingly for a lower outer cell by replacing c“ with c*. ■ 


Lemma 23: Let e = Ae. Then for any inner or outer cell k of a pruned e-ball Dg it holds 


Dbad ( ^ ) ^ 


M"~^(^CobstU.±e-0^g-~^) 


where for an inner cell Xf = (cf’ + cf'^)l2 is the cell center in dimension i or for a lower or upper outer cell Xi = cf®* or 
Xi = cfis the lower or upper boundary of Be in dimension i, respectively. 

Proof: Df < 2e < 4e from the definition of an inner cell of the pruned e-ball with diameter 2e. For the outer cell, 
Df < 2e and hence 2Df < 4e. For the inner cell, we have to show that 

/r"-i(((^Cobst n /c)|, © n K|J < /r”-i(^CobstU,±s © Bf-^) 
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Fig. 10. The figure shows the derivation of an upper bound on the volume where a bad sample qi might be found (dash-dotted rectangle) potentially leading 
to a cell split in traversing dimension of an outer cell k (thin black rectangle) of a pruned e-ball Be{'^{l)) cutting through The corresponding 

non-pruned e-ball Be('){l)) is given by the bold black rectangle. 


Taking a look at the volumes that are measured on both sides of the equation we can see that 

(((5Cobst n k)\. ©nK|, c (5Cobstn k)\. © 

c (( 5 CobstnK)|. ©sp"^ 

C ( 5 CobstU,±£©S?-i. 

The first inclusion comes from deleting the last intersection which can make the set only bigger. The second inclusion uses 
e = 4e > D'^ and A(BBCA®B'ifBC B'. For the third inclusion we recall that Xi = (cf* + c™)/2 is the center of k in 
dimension i. Now Xi — e < cf and Xi + e > c™ and thus we get from the definition of \xi±e that ((5Cobst FI «;)|^ C (5CobstUi±e- 
And from the monotonicity of the measure get 

F"-'(((5Cobst n © Blf) n «|J < /r"-i(5CobstU.±s © sr') 

For the upper outer cell, we have to show that 

fi’^-'(((<5Cobst n © B'^-}) n /C|J < Ai’^-'(<5Cob.stU.±e © sr') 

Again taking a look at the volumes that are measured on both sides of the equation we can see that 

((JCobst n © B'^-}) n K|, c (^Cobst n © b^-} 

C <^Cobst|c4±r>f © 

Q <^Cobst|c"±r>f © 

C (5CobstU,±s © 

The inclusions work analog to those for the inner cell. ■ 

Now we show that this upper bound on the probability of finding a bad sample goes to zero with e for almost all Xi. 
Figure [TT] illustrates the contrast of constant lower bound on finding a good sample and diminishing upper bound on finding a 
bad sample when the size of the pruned e-balls of the finite covering of 7 goes to zero. The figure shows how the upper bound 
evolves when cells are split in equal halves just for illustrative purposes. This exact halving has no basis in the algorithm of 
PCD. With respect to the lower bound on finding a good sample the illustration is not to scale in terms of Lemma [B] 
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Fig. 11. The figures show the upper bound on the volume where a bad sample might be found (shaded red) potentially leading to a cell split in traversing 
dimension and the lower bound on the volume where a good sample might be found (shaded green) clearing the entire intersection of k, and the pmned 
e-ball Be- From figures (a) to (e) the cells are split in half in traversing dimension. While the lower bound on the probability of finding a good sample stays 
constant, the probability of finding a bad sample decreases to zero with the cell width in traversing dimension for almost all cells. Path 7 : bold black line; 
obstacles: shaded blue, bounded by dotted line. 


Unfortunately, the upper bound on the probability of finding a bad sample does not go to zero for all Xi. For some Xi 
the probability has some positive lower limit. The problems arise where 5Cobst runs exactly perpendicular to the traversing 
dimension i over an area with nonzero The third cell from the left in Figure 0e gives a rough idea about this issue. 

In the following, we use some results from basic algebra; Let or shorter be a hyperplane perpendicular to dimension 
i through Xi. If a single polynomial / : K." —)• R is zero on a subset of with nonzero measure it is zero on the entire 
hyperplane. Thus / reduces to a polynomial in Xi only. A polynomial in one variable which is not the trivial zero polynomial 
has at most d real zeros, where d is the degree of the polynomial. Thus / can be zero on at most d hyperplanes perpendicular 
to dimension i. Since JCobst is a semi-algebraic set defined by a finite number of polynomials with finite degree, the number 
of hyperplanes with n ^Cobst)|J > 0 is finite. According to the definition given above for {Hxi H (5Cobst)|i we 

can write (5Cobst|^.- 

In our analysis of the upper bound on finding a bad sample we therefore restrict ourselves - for the moment - to cells k that do 
not contain areas on SCobst exactly perpendicular to the traversing dimension i with > 0. With Xi = ((5Cobst|^ ) > 

0 } being the finite set of Xi where JCobst runs perpendicular to dimension i on an area with nonzero we define 

ATobst = cl(5Cobst \ U HxJ. 

Xi&Xi 

Thus with an uppercase A® we denote the boundary of Cobst stripped by all points on hyperplanes Hx^ with (^CobstHiTxi) > 
0 adding back the limit points of this set to maintain a closed set. Thereby, the following analysis is valid only for cells that 
do not intersect with such a Hyperplane Hx^. 

We now show that when we let the size of the pruned e-balls around 7 go to zero, for all cells of a pruned e-ball not 
intersecting with a hyperplane as defined above the upper bound on the probability of finding a bad sample goes uniformly to 
zero, i.e. >0, 3e > 0, Vxj e [0,1] : /r"“^(A*CobstUi±e © 

Lemma 24: For all 1 < z < n. 


/(xi) = /r"-7ATobstU.±e © B^-^) 0 ^ F 

£—>•0 

on [0,1]. 

To prove Lemma l24l we need the following intermediate results: 













































19 


Lemma 25: If 

M”-i(ATobstU.±e © B^-^) /i-i(ATobstU.±e) and 

£—>•0 

/x"-i(ATobstU.±e) ^^0 then 

e—^0 

(ATobstU,±s ©i^r') 0. 

£—>•0 

If the expression converges uniformly when letting one e go to zero and holding the other one fixed, then the expression 
converges uniformly also when letting both e go to zero. 

Proof: From p{xi) = /r”“^(A*CobstUi±E © 5”“^) /r”“^(A*CobstUi±e) it follows that V ?7 > 0, 3ei > 0, Vsi > 

£^0 

e > 0, Vxi e [0,1] : 

Ar”-'(ATobstU.±s ©-B^') -F”-'(ATobstU.±e) < V- 

From P{xi) = /r"“^(A*CobstUi±e) 0 it follows that Vp > 0, 3e2 > 0, V £2 > e > 0, Vx^ € [0,1] : 

£—>•0 

,n —1 ( \ i 


(ATobstUiie) < V- 


But then it follows that Vp = 2r], 3e = min(ei,£ 2 )j Vs < e, Vx^ € [0,1] : 

/r"-i(ATobstU.±e © Sr') < 2r; = 77 

and therefore p"’“^(A®CobstUi±e © B^~^) 0. ■ 

£—>0 

So to get uniform convergence for f{xi) = /i"“^(A®Cobst|xi±£ ® B^~^) on [0,1] we have to proof uniform convergence for 
and /^. We switch to the standard form for proving convergence of a sequence of functions and replace e by 1/p and let 
p go to infinity instead of e to zero; fp{xi) = f^{l/p,Xi) = /^(e, Xi),/^(x*) = p{l/p,Xi) = p{e,x^). 

Lemma 26: Let /p(xj) = M"“H^*CobstUi±i/p), then 




p—¥00 


on 


[ 0 , 1 ]. 


Proof: Dini’s theorem (see for example ifTTll for reference) states that if a series of continuous functions (/^ : X R)pgN 
converges pointwise monotonously to a continuous on a compact set X, then converges also uniformly to on X. 

We investigate on Xi G [0,1] which is closed and bounded and hence compact. For any Xi G [0,1] let = 
A®CobstUi±i/p G C|. = [0,1]"“^. From the definition of the £-wide projection we have A*CobstUi±i/p © A®CobstUi±i/(p+i). 
Thus {oplpgj^ is a decreasing sequence of sets. For this decreasing sequence of subsets of C|. the Lebesgue measure of the 

limit is the limit of the Lebesgue measures and hence Vxi G [0,1], limp_>oo = 0. Thus = 0 and F^. 

What is left to show is that each is continuous. A function is continuous on [0,1] if for every x“"‘ G [0,1] the limit 
lim 3 ,._> 3 ,cont fp{xi) exists and is equal to /p(x“"‘). This holds true if the limit of lim 2 ,^_^ 2 .coni fp{xi) — /p(x“"‘) exists and is 
equal to zero. Let Xj = x“"‘ + e. But then 

/2(x0=M"-'(A*CobstU,±i/p) 

P (A Cobstj [xi —l/p, Xi + l/p]) 

P (A Cobstj [a:™"^+£—1/p, a,^‘’''‘+£+l/p] ) 

/2(xr) = p"-i(A*Cobs.Ur±i/p) 

= F” ^(A*Cobst|[a;“"‘-l/p, xf"'+l/p]). 

Let now 

a = pF P(A®Cobst|[a;““‘+l/p, a;””‘+l/p+£]) 
b = pF P(A®Cobst|[a;““‘-l/p, a;5“-l/p+£]). 

Then it holds 


fl{xf) < /p(x“"‘) + a 
fl{xT)<fl{xi) + b 
fl{xT)-h<fl{xi)<fp{xT) + a 
-b < fpixi) - /p(x“"‘) < a 
\fpix^) - /p(a;r‘)l < max(a,h). 
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Fig. 12. The figure shows that the f^{xi) = ^(A'CobstU^ie © are in general not continuous. The blue square in the center represents an 

obstacle in C. <5Cobst is hence a rectangular frame around the blue area. A*Cobst shown by black lines is this boundary stripped by all subsets that share an 
area with hyperplanes perpendicular to dimension i with nonzero In the lower part of the figure, the graph of fp{xi) is shown. Where A®CobstUi±e 

starts to contain a part of A'Cobst> fp is discontinuous. 


By showing that both a and b go to zero for e —)■ 0 we conclude that the limit exists and is equal to zero. Thus, the are 
continuous on [0,1] for all p. But for e going to zero both A*Cobst|[x“”‘+i/p, a:“"‘+i/p+e] A®Cobst|[x“”'-i/p, x"“-i/p+£] 
are decreasing sequences of subsets of C^. with the limit of the measure being the measure of the limit which are 
/r"“^(A*CobstU“"'-i/p) /r"“^(A®CobstU“"‘+i/p), respectively, which are both equal to zero. 

Thus we have a sequence of continuous that converges pointwise monotonously to a continuous on a compact set 
[ 0 , 1 ], and hence converges also uniformly to on [ 0 , 1 ]. ■ 

Lemma 27: Let fp{xi) = /r"“^(A*CobstUi±e ® *en 

TiifiTily /i"-l(ATobs.U.±£) = F\x,) 

^ p—^OO 

Proof: A®CobstUi±e is a closed semi-algebraic set. A closed set is equal to its closure. The closure of any set A is given 
by cl(A) = npgN(^ + Bijp) and hence for closed sets A = limp_>.oo A 0 Bi/p. For a decreasing sequence of subsets of C\. 

the Lebesgue measure of the limit is the limit of the Lebesgue measures and hence Vxi € [0,1], fp{xi) F^{xi). Since 

^ p^oo 

the measured set in /p+i is a subset of the measured set in for any p, the decrease monotonously. 

Following the argument in the proof of Lemma |26| the limit function F^ is continuous. Since - again - [0,1] is compact 
we would need to show that each fp is continuous to use Dini’s theorem to prove uniform convergence. Unfortunately, the 
fp are in general not continuous. See Figure [T2| for an example. However, the are discontinuous at finitely many x'^., 
1 < k < only where the are independent of p (see Lemma jSTJ. Furthermore, if fp is discontinuous in x^ from the left, 
then /p(x^) > fpix‘1 — e) for sufficiently small £ and /p(x^) > /p(x| + £) for fp discontinuous in x^ from the right (see 
Lemma (3^. 

Now partition [0,1] into k'^ + 1 compact intervals Ik = [x^,x^^j^] with Xg = 0 and = 1. We will prove uniform 

convergence for all : h M,/p\fe(xi) = f^^xf) for x* e (x|,x^_^i) and /p^Jx^) = fpW^) and /p\fc( 4 -bi) = 

lim,j,/in Lemma 1^ 

But now for each k the are a sequence of continuous functions on a compact interval decreasing monotonously and 
converging pointwise to a continuous function (see Lemma [33]). According to Dini’s theorem, all ^ converge uniformly 
to fl- For all Xi S int(/fc), fp^ki^i) = fpi^i)- Thus we have for each 0 < fc < fed that V 77 > 0, 3Pfe, Vp > Pk, Vx S 
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int(4), I/p (x) — f^{x)\ < r]. Similarly we get from the pointwise convergence of fpixj.) for each 0 < fc < fcj + 1 that 
Vp > 0, 3P^, Vp > If^ixi) - f\x<l)\ < rj. But then we have Vry >0, 3P = max(Po,... ,Pfc,,P^,.. ■ ,Pfc,+i), Vp > 

P, Vcc S [0,1] |/p(a;) — f^ix)\ < rj and hence uniform convergence of to on [0,1], ■ 

For proving the required continuity of we need a continuity concept for set-valued maps. In general, the continuity concept 
of single-valued functions does not trivially extend to higher dimensions. Instead one can define semi-continuity properties 
like upper and lower or inner and outer semi-continuity and a map is said to be continuous if both semi-continuity properties 
are fulhlled. See for example ED and mi for reference. Fortunately, for the compact-valued set-valued maps we want to 
examine, the continuity concepts are equivalent. In the following we use the Hausdorff continuity as it expresses continuity in 
the 6 — e-notation similar to the continuity of single-valued functions. 

The Hausdorff metric gives a notion of distance between two sets. Using this metric, we can dehne continuity of set-valued 
maps with the standard <5 — e-notation. We use ry instead of S to avoid confusion with regard to the boundary of C-space 
obstacles i5Cobst- 

Definition 11 (Hausdorff distance): By 

(in : X X ^ R, dn{A, A') = inf |e > 0|A C 4' -f A A' C A -f Pej 

where P^ is the closed e-ball around zero we denote the Hausdorff distance. 

The Hausdorff distance quantihes the largest distance from any element of A to the respective closest element of A' and 
vice versa. 

Definition 12 (Hausdorff continuity): A set-valued map M : [0,1] =1 is called Hausdorff continuous from the left in 

a; € [0,1] if Vp > 0 3e > 0 Ve > e > 0 {x — e) , M(x)) < rj. Accordingly, with dii{M{x + e), M(x)) < p for 

continuity from the right. If a set-valued map M : [0,1] ^ is Hausdorff continuous from the left and from the right in 

X G [0,1] it is said to be Hausdorff continuous in x. If such a map is not Hausdorff continuous from the left and / or from 

the right in x it is said to be Hausdorff discontinuous in x. 

Lemma 28: If the semi-algebraic set-valued map M : [0,1] ^ = A®CobstUi±e © continuous in Xi 

from the left (right), then the function fp{xi) = /r"“^(A*CobstUi±E © continuous in Xi from the left (right). 

Proof: Assume fp{xi) = /i"'“^(A®CobstUi±e © ^ijp) discontinuous from the left in Xi. Then 3p Ve > 0 3e with 
e > e > 0 and \fp{xi -he) — fp{xi)\ > p. For ease of notation let A{xi) = A*CobstUi±e © ^i/p^ the above reads 
\fj,^~^{A{xi)) — fj,'^~^{A{xi+e))\ > ry. This implies that ((A(xi) U A{xi + e)) \ {A{xi) fl A{xi + e))) > ry. Since A{xi) 
and A(xi + e) are compact this implies the existence of an open ball B° in either A{xi) \ A{xi + e) or A{xi + e) \ A{xi) 
where any point in P° has a positive Hausdorff distance to A{xi} or A{xi -f e). So, the semi-algebraic set-valued map 
M : [0,1] ^ Mfxi) = A*CobstUi±£ © cannot be Hausdorff continuous in Xi from the left. 

Accordingly for M continuous in Xi from the right. ■ 

Lemma 29: If the map [0,1] =1 • M{xi) = A^CobstU is continuous from the left (right), then also the map 

[0,1] —> : M'{xi) = A*CobstUi±e © ^ijp continuous from the left (right). 

Proof: From M{xi) = A®CobstUi±e is continuous from the left (right) in Xi it follows that Vry > 0 3e > 0 Vf > e > 0 it 
holds dHiM{xi—e),M{xi)) < ry. That means Vg G M(xi—e) 3g'G M(xi) with g G g'©P,, and Vg'G M(xi) 3q £ M{xi—e) 
with g' G g © P,,. But then also it holds Vg" G P"/~^ that Vg G M{xi — s) 3g' G M{xi) with g -t- g" G g' + g" © and 
Vg' £ M{xi) 3g G M{xi — e) with g' -I- g" G g 3- q" © Bp and hence M' is continuous in Xi from the left. Accordingly for 
continuity from the right. ■ 

Lemma 30: M : [0,1] =1 W^~^,M(^Xi) = A®CobstUi±e is discontinuous in finitely many Xi £ [0,1] only. 

Proof: As a corollary of their main result Daniilidis and Pang ll20l show that; 

A closed-valued semi-algebraic set-valued map S : X ^ R"*, where X C R" is semi-algebraic, is continuous and set-valued 
differentiable outside a set of dimension at most (dim A" — 1). 

For our case we take X = [0,1] C R^ which is semi-algebraic and conclude that the closed-valued semi-algebraic set-valued 
map M : A =1 ,M(xi) = A®CobstUi±e is discontinuous on a set of dimension at most (dimA — 1) = 0. Thus, it 
can be discontinuous only on a point set V C [0,1]. For the 1-dimensional case, from the derivation of this result using 
a hnite Whitney stratification with hnitely many critical values we can even conclude that V is hnite. Thus, M : [0,1] =1 
R”“^,M(xi) = A*CobstUi±e is discontinuous in finitely many Xi £ [0,1] only. ■ 

Combining the results of Lemmas 128]-|30] we get 

Lemma 31: The function fp{xi) = yt”“^(A®CobstUi±e © ^ijp) is discontinuous in hnitely many G [0,1] only. 
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Proof: Lemmastates that the set-valued map M{xi) — A*CobstUi±e is discontinuous in finitely many xf G [0,1] only. 
From Lemma l29l we get that M'{xi) = A®Cobst|xi±£ ® discontinuous only in Xi where M{xi) = A'CobstUiie 

is discontinuous and from Lemma |28]we conclude that for fp{xi) = /i"“^(A®Cobst \x,±e © ) being discontinuous in xi, 

M'(xi) = A*CobstUi±e®^”/^^ has to be discontinuous in Xi. Thus, fp{xi) = /r"~^(A*CobstUi±£®-B"^~^) can be discontinuous 
in finitely many xj € [ 0 , 1 ] only. ■ 

Lemma 32: If fp{xi) is discontinuous in xf from the left, then fp{x'^) > fpix^ — s) for sufficiently small e and > 

fp for fp discontinuous in xj from the right. 

Proof: As shown in the preceding Lemma, if is discontinuous in from the left (right), then also the set-valued map 
M{xi) = A®Cobst|xi±E has to be Hausdorff discontinuous in x^ from the left (right). 

Assume M{xi) is Hausdorff discontinuous from the left. Then Ve > 0 3e with e > e > 0 3q G M{xf) with 
q f. M{x'l — e) (B Bp or 3q' G M{xf — e) with q' f. M{x^) © Bp. Due to the compactness of A®CobstUi±£ there cannot 
be an q' G M(x^ — e) with q' ^ Af(x^) © Bp for all e > 0. Hence, \/e > 0 Be with e > e > 0 3q G M(x^) with 
q ^ M{xf — e) (B Bp. But then, lime^o -^(x^ — e) C M{xf) and lime^o -^(x^ — e) © Bi/p C M{xf) © B^/p and hence 
M{xf—s)'BBifp) < fj,"~^{M{x'^)BBi/p). So if fp is discontinuous in x^ from the left, then/^(xf) > fp{x‘l—s) 
for £ small enough. 

Accordingly for fp discontinuous from the right. ■ 

Lemma 33: Let Ik = [x^jX^_|_j^] with Xg = 0 and = 1 and x^ for 1 < k < the k'^ points in [0,1] where 

fp is discontinuous as required in Lemma |27] For each k G [0,...,fc‘^] let now fpk-^k—> fp ki^i) ~ fpi^i) for 
Xi e (4-4-bi) /p\fe(4) = fpix'z) and f^ki^i+i) = fpixf ). Then f^^ converges uniformly to 

an with Vx^ S int( 4 ), F^{xi) = F^{xi). 

Proof: We first show that the limit from the right in x^, lim,j,/x^,,,d fp{x'i) and the limit from the left in 
lim,^/^,j,d ^ fp{xi') exist, fp is discontinuous in x^. Thus it is discontinuous in x^ from the left and / or from the right. 
If fp is continuous in x| from the right then trivially the limit lim,j,/N^3,d fp{x'i) exists and is equal to /p(x|). Accordingly 
for the limit from the left in x^ if fp is continuous from the left in x‘l_^_^. 

If fp is discontinuous in xj. from the right then 

lim f^{xi') = lim /r”“^(A*CobstU'±£ ® 

For all p, k, fpkixk) = fpkixt) on {x'l,x'l^^). Thus, from the continuity of fp on the open interval we directly conclude 
continuity of f^,^ on the open interval. But since f^kixi) = f^ix'^) and flkixt+i) = lim^,^,,d^^ fpixf), f^k is 

continuous from the right in x^ and continuous from the left in x^_|_j^ but then f^ ^ is continuous also on the closed interval. 
From the definition of fp and hence fp we get fp^^^ < fp. 

But now we have a decreasing sequence of continuous functions ff j. converging pointwise on a compact interval Ik to a 
continuous function Ff. Dini’s theorem gives uniform convergence on Ik. ■ 

Proof of Lemma \24\ But now we have shown that both expressions required in Lemma l25] converge uniformly and hence 

also 

M"-i(ATobs.u.±£ © i?r') 0. 


Now we have bounded the probability of finding a good sample from below independent of k and e and have shown that 
by shrinking the pruned e-balls we can let the upper bound on finding a bad sample go to zero for any inner or outer cell of 
a pruned e-ball containing a straight line segment of 7 but not intersecting with a hyperplane 

Thus, we can choose e such that whenever an inner cell of a pruned e-ball of the finite covering of 7 is sampled, the 
probability of finding a good sample clearing the entire intersection of k with the pruned e-ball is larger than the probability 
of finding a bad sample potentially leading to a cell split in traversing dimension. 

What is left to show is that neither the pruned e-balls holding the cells intersecting with a hyperplane iTa,. with nonzero 
nor pruned e-balls holding a corner of 7 can be sampled arbitrarily often. 

We have shown that for any dimension i there exist only a finite number of hyperplanes as defined above. 

Lemma 34: There exists an e > 0 such that for any e < e any pruned e-ball with traversing dimension i intersects with 
at most one hyperplane Hx^. 

Proof: Let Xi = {xi|/x"“^((5Cobst|a, ) > 0} be the set of Xi where corresponding hyperplanes exist. Then 
mina,/a-'/gXi rf(x[, x") is the minimum distance in dimension i between any two of these hyperplanes. Thus, with e = 
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minj;'a;")/2 the Lemma holds, since such a ball would have a width of less than the minimum distance of 
any two hyperplanes ■ 


So for any inner cell of such a pruned e-ball with traversing dimension i we can be sure that it intersects with at most one 
hyperplane . For the outer cells of such a pruned e-ball this is unfortunately not true and we cannot affect the number of 
hyperplanes an outer cell intersects with by choosing the size of the ball. Fortunately this is not necessary. Recall the derivation 
of the upper bound of finding a bad sample in an outer cell in Lemma |22] It showed that the probability of fmding a sample 
leading to a split in traversing dimension i depends on ^Cobst in a volume that is bounded in dimension i by cf ± Dl where 
DI is the width of the intersection of the cell and the ball. Thus, a hyperplane might affect the probability of finding a 


bad sample in an outer cell of a pruned £-ball only if Xi € 


-Bgl r) 

Ci -2e,Ci 


2 e 


Lemma 35: There exists an e > 0 such that for any e < e the probability of finding a bad sample in any pruned e-ball 
with traversing dimension i is affected by at most one hyperplane H^^. 


Proof: Thus, we have to ensure, that in dimension i at most one hyperplane lies inside 

d ^cfcf= 2e, so any two hyperplanes must be at least 6 e apart. Thus, with e = min 
Lemma [3] the Lemma holds. 


cf- 2 e, cf 


2 £ 


. But 




So we have shown that in any pruned e-ball there is at most one cell where the probability of finding a bad sample splitting 
the cell in traversing dimension i inside the ball is affected by a hyperplane We denote this cell with Whenever 
is split in the traversing dimension i, only one of the resulting new cells intersects with The label passed to 

this new cell intersecting with 

Lemma 36: For a cell intersecting with a pruned e-ball and a hyperplane the expected number of times the 
respective cell intersecting with gets split is bounded from above. 

Proof: Of course also for any cell holding the label k*’5'p the general lower bound on the probability of finding a good 
sample holds and is equal to e". But then, the probability of finding a good sample after at most k splits is larger or equal 
to the probability of success after at most k Bernoulli trials with p = e" and we can derive an upper bound on the expected 
value of times k^^p gets split before being cleared around 7 from the geometric distribution being E = 1/p. Thus, the expected 
value of times k^^p is split before it is cleared around 7 is bounded by Li < e“" and hence finite. ■ 

So we have shown that any pruned e-ball holding a straight line segment of 7 with e small enough according to above 
lemmata will not be sampled arbitrarily often but will be cleared after a bounded expected number of times it got sampled. 

Even pruned e-balls holding a corner of 7Man will not be sampled arbitrarily often: 

According to Lemma [141 for e < e any pruned e-ball around 7 holds either a straight line segment or a single corner 
connecting two straight line segments of 7 . We have shown so far that pruned e-balls holding a straight line segment of the 
path will not be sampled arbitrarily often but will be cleared before. We will now extend this result to pruned e-balls holding 
a corner configuration. Let B^ be a pruned e-ball holding a single corner of 7 . 

Now for any such B^ at any time there exists exactly one possibly free or possibly occupied cell that holds the corner 
configuration of 7 . When this cell gets split, only one of the two resulting cells will hold and the label is passed 

on to this cell. We can neglect cases where this corner configuration exactly lies on the boundary of two or more cells. The 
exact location of the corner configuration given by the algorithm in the proof of Lemma |3 is arbitrary and there exists a whole 
continuum of Manhattan paths. 

All other cells intersecting with B^ contain a straight line segment of 7 only. For these cells there exists a well defined 
traversing dimension i, so we can use the results found above for e-balls holding a straight line segment of the path. 

For the same lower bound on finding a good sample holds. We actually don’t care about a diminishing upper bound 
for a bad sample. Instead for our aim to prove probabilistic completeness, the following Lemma is sufficient. 

Lemma 37: For a pruned e-ball holding a single corner configuration yiP™) the expected number of times the respective 
cell holding the corner configuration gets split is bounded from above. 

Proof: Of course also for any cell holding the label k^°’^ the general lower bound on finding a good sample holds and is 
equal to e". Thus, the upper bound on the expected number of times k^°'^ gets split before being cleared around 7 is equal to 
the result found in Lemma |31 hence finite. ■ 


Thus, a pruned e-ball holding a corner connecting two straight line segments of 7 will not be sampled arbitrarily often but 
will be cleared after a bounded expected number of times it got sampled. 

The probability that PCD solves the path planning query approaches one with the number of iterations of PCD going to 
infinity: 
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Lemma 38: If all pruned £-balls of a finite covering of a pruned s-tunnel around 7 Man are cleared, the path planning query 
is solved and part <a> and hence PCD return with success=true. 

Proof: If all pruned £-balls of a finite covering of a pruned s-tunnel around 7 Man are cleared, all cells intersecting with 
any pruned e-ball are cleared around 7 and hence are possibly free. But then from the strictly positive diameter of the pruned 
e-tunnel we get that adjacent cells of = {k\k fl 7 Man ^ 0} share a common area on the dividing hyperplane with nonzero 
and — put in the right order — form a cell path </>. In the next iteration of <a>, f indCellPath will consequentially 
return a cell path. A continuous path through this channel is then checked for collision. If any collisions are found, cells along 
the cell path get split. However, non of the splits will affect any of the pruned e-balls since these are cleared and will never 
again be contained in a possibly occupied cell. Hence, in all remaining iterations of <a> f indCellPath will return a cell 
path. However, the result of Lemma | 6 ] limits the number of iterations of <a> after which the while loop breaks. Since still 
a cell path can be found, checkPath (cellPath) will return true and consequentially <a> and PCD will return with 
success=true. ■ 

Proof: Proof of Proposition [T] 

But now we have shown that 

« 7 can be assumed to be of Manhattan-type. 

« e can be chosen small enough such that the e-tunnel around 7 is collision free with a hnite covering by e-balls. 

• In each iteration of PCD <a> returns after a bounded number of iterations and hence the total number of iterations of 
PCD goes to inhnity. 

• In each iteration of PCD the probability of hnding a sample in any e-tunnel can be bounded from below independent of e 
and hence in at least one ball of the finite covering, the number of samples goes to infinity with the number of iterations 
of PCD. 

• e can be chosen small enough such that the expected number of times a pruned e-ball gets sampled before it is cleared 
is hnite for both e-balls holding a corner and e-balls holding a straight line segment of the path. 

• At the latest when all pruned e-balls of the hnite covering are cleared, PCD returns success. 

« Consequentially, the expected number of iterations after which PCD returns success is bounded and hence PCD is 
probabilistically complete. 


IV. Conclusion and Future Work 

We have shown that PCD is probabilistically complete for a conhguration space C = [0,1]" with C-obstacles modeled as 
semi-algebraic sets. 

This proof is based on the assumption that collision-free samples found while checking a continuous path in part <a> of 
Algorithm [1] are not stored in the respective cell. By not using these samples, we through away valuable and often costly 
information about the shape of Cfree- Even being crucial to some parts of the proof, we are conhdent that incorporating these 
samples does not harm probabilistic completeness. From the experience of using PCD on a variety of path planning problems, 
we have no evidence that PCD could be not probabilistically complete when doing so. Therefore, for applications we propose 
to continue to store these samples in the collision-free cells. It remains to show that PCD is still probabilistically complete 
when incorporating these samples. 
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